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ABSTRACT 


This thesis conducts a state-space analysis of the Mark 
6 gyro used in the Trident II missile system. Optimal 
control techniques, utilizing a region controller, have been 
employed in designing a gyro controller. The response of 
the system to missile motion is examined and compared to the 
system response uSing the current control laws. It is shown 
that an optimal region controller reduces the gyro error in 
the system while effectively avoiding gimbal lock, a situ- 
ation which exists when gyro orientation prevents missile 
motion from being isolated in an orthogonal three axis coor- 
dinate system. Recommendations for the application of addi- 


tional modern control techniques are included. 
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I. INTRODUCTION 


A need for accurate, self-contained navigation systems 
has existed since the early days of aircraft design. The 
most common of these systems uses accelerometers to deter- 
mine body motion. The output signal is integrated once to 
obtain velocity and again to obtain position. 

In order for the navigation system to accurately deter- 
mine body motion the sensors must be mounted on a platform 
fixed in a known coordinate system. In ballistic missile 
guidance systems, gyros are used to fix a platform in iner- 
tial space. The accelerometers are mounted on this plat- 
form. The purpose of the gyro controller, then, is to 
generate the gyro torque motor commands necessary to main- 
tain the stable platform fixed in inertial space. 

Since 1957, the Charles Stark Draper Laboratory in 
Cambridge, Massachusetts has designed the gyros for the 
Navy's Polaris, Poseidon and Trident missiles. Because of 
the complex, highly non-linear nature of the control system, 
this design process has been a tedious, iterative affair. 
Using state-space representation of systems, computer-aided 
optimal control design techniques greatly simplify the 
multi-input, multi-output non-linear time varying problem. 
The goal of this thesis is the development of a state-space 
model of the Trident II gyro system, the Mark 6, and the 
application of modern control theory to improve system 
performance. 

A state-space model of the system has been developed and 
1S compared to the current gyro model. Transient response 
of both systems to missile motion is examined. Modern 
control techniques uSing optimal feedback gains are employed 
to minimize gyro errors and improve system response. The 


choice of optimal feedback gains is made based on a region 


controller which selects the gains dependent upon the 
particular gimbal angles. Finally, suggestions are made for 
employing modern control techniques to further optimize 


system performance. 


II. FUNCTION OF THE GYRO CONTROLLER 


A. THE ALL-ATTITUDE GIMBAL ASSEMBLY 

The inertial navigation system for a ballistic missile 
must accurately determine missile motion in three orthogonal 
planes. Missile motion is resolved by accelerometers 
mounted on a platform fixed in inertial space. A three 
dimensional coordinate system is initialized before missile 
launch, and remains fixed through out the flight. The func- 
tion of the gyro controller is to keep the stable platform 
fixed throughout the flight. 

The Mark 6 gyro consists of four concentric gimbals as 
shown in Figure 2.1 [Ref. 1: p. 2]. The innermost gimbal is 
the stable platform, housing the accelerometers. As the 
missile experiences pitch, roll and yaw a torque is applied 
to the gimbals in such a manner as to isolate the stable 
member from the motion. 

lL. Gimbal Lock 

In addition to maintaining a fixed inertial refer- 
ence, the gyro controller must prevent "gimbal lock". This 
occurs when the gimbals are co-planar and it becomes impos- 
Sible to isolate missile motion on three orthogonal axes. 
Controlling the gyro errors is relatively straightforward, 
while preventing gimbal lock is more complex. Since the 
gimbal angles can asSume any value during missile flight, 
the problem becomes non-linear and difficult to solve. The 
technique developed by Draper Laboratory for preventing 
gimbal lock will be employed in the design of the state- 
Space system model. This technique is more fully described 
in the next chapter. 

2. Missile to Stable Member Motion Coupling 

The four gimbal IMU model is shown in Figure 2.2 


Ret. (25°. °pyaeZ- Missile, or base motion occurs in the 
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Figure 2.1 Four Gimbal Gyro Model. 


ee) 5» Kc coordinate system. This motion is coupled to the 


Stable member coordinate system LL poset by the outer, 


middle and inner gimbals. The system accuracy is measured 
Pemeewece gyro error of the stable member in the 1)],)].k, 
Space. Appendix B contains the detailed transformation of 


missile motion in the base frame of reference to motion in 


meee inertial frame. 


we 


oh co! 





Figure 2.2 Four Gimbal Gyro Coordinate Systems. 
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IIIT. MARK 6 GYRO MODEL 


A. BLOCK DIAGRAM 
The Mark 6 Gyro model presently being used by Draper 
Peaperatory is shown in Figure 3.1 [Ref. 2: p. 8]. Table III 
in Appendix A contains a definition of abbreviations used in 
this thesis. The torque motor commands are the inputs to 
the system, with the gyro errors and gimbal angles as the 
output. The diagram illustrates the cross-coupling between 
gimbals represented by the input equations shown in Figure 
Bel . 
ieee lant | Drarpram 
a. Signal Conversions 
Figure 3.1 contains the electrical and mechan- 
ical realizations of the Mark 6 gyro. The input signal is 
expressed in terms of quanta, with one quanta equal to 
0.0735 volts. The torque command iS expressed in ounce- 
inches. The gimbal angles, given in radians, are converted 
to quanta for input to the feedback controller. 
b. RGyro 
Also shown on the diagram is the RGyro. This is 
not a part of the plant. The RGyro defines an error associ- 
ated with the roll axis. In earlier three gimbal gyros, the 
roll axis of the missile did not coincide with any of the 
gimbal axes. The four gimbal Mark 6 gyro aligns the roll 
axis with the outer gimbal axis, thus eliminating the need 
for the RGyro as an indication of gyro error. The output is 
still provided for ease in comparing current model errors 
with previous systems. 
c. Gimbal Inertias 
The gimbal inertiasS are represented in Figure 
3.1 as Js, Jz, Jy and Jo for the stable member and inner, 


middle and outer gimbals respectively. The outer and middle 
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Mark 6 Gyro Model (Inertial Mode). 


Figure 3.1 
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gimbal inertias change with time as a function of the inner 


gimbal angle. Figure 3.2 shows how the inertias are 
resolved [Ref. 2: p. 6]. 





J, = rj cos 0 


resolving along the x and y axes: 
2m sin* § = Seong 9) 

we = 1 2m = r,“m cos2 § = J cos? 9 

y x 1 O 


Cy 
tt 
— 

No 
=) 
tl 
a 
—_ 
S 


for the four gimbal model: 
- 2 
Jum = Jy + Jr + “S°T, E> 


Figure 3.2 Resolution of Outer and Middle Gimbal Inertias. 
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d. Stable Element 

The stable member is represented by the upper 
flow path in Figure 3.1. There are no external inputs to 
the stable member, with only friction affecting the loop. 
The stable element is controlled by its own feedback loop 
and is not influenced by the other system signals. Signals 
from the stable loop do cross-couple to the other gimbals, 
however, with the torque command coupling to the middle and 
outer gimbals. The inertial rate S serves as an input to 
the stable member angle, shown at the bottom of the figure. 
This angle could also be shown connected to the stable 
element flow path, with an input from the outer gimbal iner- 
tial rate. Because the stable member is affected only by 
friction, it has not been included in the state-space model. 

e. Sampling Rates . 

Two different sampling rates are uSed in the 
system. The U, V and W gyros are sampled at 300 Hz. The 
gimbal angles are sampled at 100 Hz. 

f. Gimbal Lock Avoidance 

The proximity of the system to gimbal lock can 
be measured by observing the sines of the inner and middle 
angles. The product SIN (A; )*SIN (Ay) gives an indication of 
how close the system is to gimbal lock, with gimbal lock 
occuring when the product equals one. The goal of gimbal 
lock avoidance is to drive the product of the sines to Zero. 
This is accomplished by setting either the inner or middle 
angle to O or 180 degrees. 

Only one angle need be controlled at a time. 
Figure 3.3 shows the regions where control would switch from 
one angle to another. This is based on the smallest of the 
absolute values of the Sines. 

The missile motion input to the U and V gyros 
has a gain factor of SIN(A,)*SIN(A;), as seen in Figure 3.1 


Thus, in addition to avoiding gimbal lock, nulling the 
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Figure 3.3 Gimbal Lock Avoidance Switching Line. 


product of the sines of the inner and middle gimbal angles 
also minimizes the effect missile motion has on gyro error. 
2. Gyro Controller 
a. Control Laws 
Figure 3.4 shows the controller for the Mark 6 
peeeomkenta 3: p. 115]. The six inputs to the controller are 
the three signals generated from the U,V and W gyros, the 
stable element gimbal angle and the sines of the inner and 


middle gimbal angles. The four outputs are the torque motor 
command signals. 
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b. Transfer Functions 
Hie Cerio etuncilonmeia(z) in the stable 
element, inner and middle gimbal feedback paths is defined 


as. 
Hy(z) = (z-.932)3(z-.80955)/(z-1)*(z-.6186) (z-.17474) 


The transfer functions H(z) and H3(z) in the 


outer gimbal control loop are: 


H(z) (z-.9778)/(z+.3827) 


H3(z) aq!) /z 


c. Redundant Torque 
The outer gimbal control loop has three inputs 
controlled by switches Q],>Qo and Q3. Two of the inputs are 
the SIN(Ay) and SIN(A;) signals. The third input is the 
stable element angle. The two signals generated by this 
loop are necessary when the product SIN(Ay)*SIN(A;) becomes 
very small and does not produce a large enough error signal 
to drive the outer gimbal. Q; and Q3 are switches with 
values of +1 and -1 depending on gimbal geometry. Switch Q5 
is closed for values of SIN(A,)*SIN(A;) less than 1/8, and 
open for values greater than 1/8. 
d. Scaling Factors 
Gain blocks with 21° and 1/2!° scaling factors 
are included in the control laws. These gain factors are 
applied in order to facilitate software processing of the 


feedback signals only. 
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IV. STATES SPACE SHOREL 


A. BLOCK DIAGRAM 
i. -Pilant ede 
The state-space model of the Mark 6 Gyro is shown in 
Figure 4.1. Where appropriate, the gains from Figure 3.1 
have been combined into a Single block. Only the inner, 
middle and outer gimbals have been modeled. Eight states 
are identified on the figure. 
2. Assumptions and Simplifications 
A number of assumptions and simplifications have 
been made in order to develop the state-space model: 


(a) there is no friction (this eliminates the stable 
element loop 


(b) all states are available for feedback 


(c) the inner and middle angles are fed back directly, 
not the sines of the angles 


(d) there are no limiters in the system 
(e) the entire system is sampled at 300 Hz 
3. State-Space Equations 
The state-space equations of the system are in the 


form: 


x(t) = AtE)x(E) + Bite ce) 


The vectors x(t) and u(t) are described in Table I. 
A(t) and B(t) are the plant and control matrices, respec- 
tively. The matrices for this system are shown in Figure 
aay ae 
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TABLE. £ 
STATE AND CONTROL VECTORS 


inner gimbal inertial rate I 
U Gyro error 

inner gimbal angle Ay 

middle gimbal inertial rate M 
V Gyro error 

middle gimbal angle 

outer gimbal inertial rate O 
stable element gimbal angle 
inner gimbal torque signal 
middle gimbal torque signal 


outer gimbal torque signal 


ae 


Plant Matrix 


0 0 0 0 0 0 0 0 

1 0 0 0 0 0 0 -Svi 
0 0 0 0 0 0 0 0 

0 0 O 1 0 0 0 0 

0 0 0 0 0 0 0 0 

0 0 0 “Sy 0 O -CzCy 0 | 


where K = 1,077,470 


Control Matrix 


0.068 0 0 

0 0 0 

0 0 0 

0 3, nO 

0 0 0 

0 0 0 
-Sy/Jqg 0 1 Jp 

0 0 0 


bz _ 


Figure 4.2 Plant and Control Matrices for State-Space Model. 


23 


V. OPTIMIZATION PECuNiOuk 


A. OPTIMAL REGULATOR 
1. Linear Quadratic Problem 
The Mark 6 gyro model can be represented by the 


state differential equation 
x(t) = AGE a(t) 9B Geen ( 6) 


The goal of the optimization technique is to drive 
the system to the desired state as quickly as possible, 
while using only practical input amplitudes. The quadratic 
integral criterion can be used to express how rapid an 
initial state is driven to the final state [Ref. 4: p. 201]. 


This criterion can be expressed as: 


J = JxT(e)R3(t)x(t)dt 


R3(t) is an appropriate weighting matrix chosen to 
minimize the output state vector. The criterion as repre- 
sented above would require very large input amplitudes, 
usually unattainable in a practical system. Including the 


input in the quadratic integral yields 
J) = J CxT(e)R3 (t)x(t) + ul(t)Ry(t)u(t)]dt 


By proper selection of Ry and R3, the output vector 
can be minimized using realizable input amplitudes. 

Since only the controlled variables are of interest, 
the cost equation can be written in terms of the output 


vector z(t), given as: 
Z(G) =" DiCe) xaGe) 
A weighting matrix R, can now be defined as: 


Ry (t) = Dat) Ree wee) 
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R,(t) is a square, positive semi-definite symmetric 
matrix having the same order as the number of controlled 
variables of the system. The selection of the specific 
values for R, and Ry are discussed in the next section. 

The inputs for the Mark 6 gyro are the signals to 
the torque motors. These signals are generated solely as a 
function of gyro error and gimbal angular position. In the 
optimal regulator problem, the inputs can be expressed in 


terms of an optimal feedback gain matrix and the states. 
u(t) = -Fx(t) 


The state differential equation can then be written 
as: 


a(n (6) Qe emei@ey) (-HaGe)) > B(t)u,(t) 


Dictmenlere Marlene external inputs, ~ u_(ajeo. 


Combining terms yields the following: 
x(t) = [A(t)-B(t)F(t)]x(t) 


In the linear quadratic problem, the control law can 


be expressed as: 
u(t) = -Ry *BTPx(t) 
The optimal feedback gain matrix now becomes: 
ee Se: 


The matrix P is found by solving the Riccati equa- 


tion: 
PA + ATp - PBR, ‘BIP + Ry = 0 


This is the solution for the steady-state optimal 
feedback gains, and is the method used to develop the feed- 


back gain matrices used to control the Mark 6 gyro. 
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2. Choice of Weighting Matrices 
The weighting matrices R,; and Ry were chosen based 


on the maximum values that the output vector and inputs 
could be expected to reach. When the weighting matrices 
have values only on the diagonal, the matrix product xT Rx 


becomes rao ke for each of the values of x. R is then 


lal 
set equal to the inverse of the maximum expected value of x, 
squared. This drives each of the terms in the cost equation 
to one when their value approaches the maximum allowed, and 
to zero when their value is small. 

3. Non-zero Steady State Outputs . 

The solution to the linear quadratic optimal feed- 
back gain problem has been outlined in the previous 
sections. This solution assumes, however, that the desired 
Steady-state value of the controlled states is zero. Since 
the Mark 6 control law includes nulling the sine of the 
inner or middie angle, it is possible that the desired value 
of the inner or middle angle be 180 degrees, not 0. In this 


case, the optimal feedback gain control law becomes: 
u(t) 7= oR eR Gee 


The vector R here represents the reference signal in 
the system, as shown in Figure 5.1. When R=0, the optimal 
control solution reduces to that shown above. 

In addition to an axis shift, driving the system to 
a non-zero set point can also be accomplished by adding a 
constant factor u. to the control input u(t). The contasas 


O 
input then becomes: 


u(t) = “Rete wus 


A u, can be chosen such that when the system experi- 
ences a shift in the set point, as the gyro controller does 
when shifting from 0 to 180 degrees, an optimal response is 
obtained while remaining within allowable input amplitudes. 
[Ref. 4: pp.270-275]. 
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Figure 5.1 Optimal Gain Feedback Block Diagram. 
This optimal constant input is defined as: 


_ -l 
Peay a (0) 2 


O 


imams equation. ei (S) 1s thevclosed loop transfer 
function from the inputs to the desired non-zero steady 
State output z,. The use of this solution requires that the 
number of inputs is equal to the number of outputs, and that 
B@essinverse of transfer function H,(s) exists. If the 
transfer function has any zeros at the origin, the matrix 
H. (0) is singular and the inverse does not exist. 

The optimal solution for the gyro controller gener- 
ates one or more zeros at the origin depending on the 
particular gimbal angles. Thus, the optimal input u. cannot 


O 
be found and the axis shift technique must be used. 


PeeeereakRK 6 GYRO OPTIMAL CONTROLLER 
1. Region Controller 
With a sampling rate of 300 Hz, computing the 
optimal feedback gains every sampling interval would require 
an enormous amount of computations. Lauro has shown that a 
region controller will yield a nearly optimal response while 


greatly reducing the calculations involved [Ref. 1: p. 8]. 


Ma 


The plant and control matrices of the Mark 6 ¢yro ~arema 
function of the gimbal angles, which in turn vary with time. 
The optimal regulator designed for the system divides the 
gimbal angle regions up into segments of 30 degrees or less. 
Optimal gains for the gimbal angles at the center of the 
region have been calculated. When the missile motion causes 
the gimbal angles to change from one region to another, the 


controller inserts the feedback gains calculated for that 


region. Figure 5.2 shows typical regional divisions for two 
angles. The regions are 10 degrees wide near zero, and 30 
degrees wide further from the origin. The figure shows a 


two dimensional plot, although the actual gyro controller 


involves four angles in four dimensional space. 





Figure 5.2 Region Controller Segments. 


Figure 5.3 contains the algorithm of the computer 
program written to implement the optimal regulator. A copy 


of the program listing is included in Appendix C. 
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initialize missile motion and gyro rates to zero 

assign initial gimbal angles 

determine initial condition vector x(0) 
restrict all angles to +/- 360 degrees 
determine optimal gain region based on gimbal angles 
assign appropriate optimal feedback gains 
calculate variable terms in plant and control matrices 
input missile motion 


calculate x(k+1) values for each state 


Preure 5.3 Algorithm for the Mark 6 Gyro Optimal Regulator. 
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VI. SYSTEM SMEs T ION 


A. SIMULATION MODEL 

The model used for system Simulation is a modified 
version of the state-space model shown in Figure 4.1. The U 
and V gyro errors are integrated, and the result nulled to 
minimize net gyro errors. The outer gimbal angle is calcu- 
lated since it affects the plant and control matrices, but 
is not used for optimal feedback. The simulation model has 
eleven states, and is shown in Figure 6.1. The plant and 
control matrices for the simulation model are given in 


Figures 6.2 andmo..:. 


B. WEIGHTING MATRICES 
1. Torque Limits 
Each axis of the gyro is driven by a torque motor. 
The amount of torque delivered by the motor is directly 
proportional to the feedback error Signal. When the gyro 
errors are zero and the sine of the selected gimbal angle 
has been driven to null, no torque is generated. 
The maximum torques which can be supplied to each 
ax1s are 
* maximum inner axis torque T,,,4, 83 oz-in 
* maximum middle axis torque Ty,,, 211 oz-in 
* maximum outer axis torque To,,, 369 oz-in 
Up to 14 percent more torque is available dependent 
upon the particular gimbal angles. This additional torque 
was not assumed to be available when designing the state- 
space system. 


2. State Output Weighting Matrix Ry 


The optimal control cost function is defined as 


J = i) [2t(t)Ry(t)z(t) + ul(t)Ro(t)u(t)]dt 


The output measurement vector z(t) is 


z(t) = [x9(t) x3(t) x(t) xg(t) xp (t) x77(t)]* 
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State-Space Simulation Model of the Mark 6 Gyro. 
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Figure 622 Plant Matrix for the State-Space Simulation Model. 
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Figure 6.3 Control Matrix for the 
State Space Simulation Model. 


The output vector weighting matrix was chosen based 
on data provided by Draper Laboratory. The output vector 
varies with time depending on gimbal angles. The states 
which comprise the output vector and their maximum allowable 


values are shown in Table II. 


TABLE ITI 
OUTPUT STATE VECTOR MAXIMUM VALUES 


x9 U Gyro 300 quanta 
X3 inner gimbal angle 30 degrees 
Xo V Gyro 300 quanta 
X6 middle gimbal angle 30 degrees 
X10 V Gyro error integral 1 
X11] U Gyro error integral 1 


The maximum value of 300 quanta listed for the gyro 


angles corresponds to an error of 0.278 milliradians. This 


5) 8 


is the maximum error attained with the current Mark 6 gimbal 
model. It was desired to allow a smaller error in the 
state-Space model. The gyro has a physical stop at 2048 
quanta, or 1.9 milliradians. If the error reaches this 
value the system will fail. 

The inner and middle gimbal angle maximum values 
were chosen as 30 degrees. This prevents the product 
SIN(Ay)SIN(A;) from exceeding 0.5. 

The maximum value of the integrals of the U and V 
gyro errors was chosen arbitrarily as 1. This limit mini- 


mized gyro error without producing excessive input ampli- 


tudes. 
The Ry matrix in terms of the output variables is 
WHC yn 0 0 0 0 
0 I/(x3),° 0 0 0 0 
ee 0 0 WiGre- 0 0 0 
0 0 @ 1/(xQeeo 0 
0 0 0 Gaps © 
0 0 0 0 0 §6««1/ (x ee 


Using the maximum values of the output states as 


given in Table II, The output cost matrix becomes 


1.11x10-° 0 0 0 0 0 

0 3.65 0 0 0 0 

Ree 0 0) Pelion 220 0 0 
0 0 0 3.65 0 0 

0 0 0 0 1 0 

0 0 0 0 0 1 


3. Control Input Weighting Matrix Ro 


The control input weighting matrix is a third order 
Symmetric matrix with the inverse of the square of the allo- 
wable torques, given previously, on the diagonal. The 
matrix is shown below. The inputs are related to the 


torques as follows: 
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fou = inner axis torque Ty 


* ug = middle axis torque Ty 


mea = outer axis torque Ty 
iL) (Ge aa 0 
0 Ga 


Using the maximum torque valueS given previously, 


the R9 matrix is: 


Th AG e210) tag 0 0 
Re) = 0 Je2saO 7? (0 
0 0 7.34x107 © 


C. TEST PARAMETERS 
Ll. Initial Conditions 
The initial conditions used for the model simulation 
were provided by Draper Laboratory. This particular combi- 
nation of initial conditions, along with the missile motion, 
has been determined to be the "worst case" situation for 
Peecor control. 


The gimbal angles have been initialized as follows: 


¢ stable member gimbal angle - QO degrees 
¢ inner gimbal angle = 90 degrees 
e middle gimbal angle - QO degrees 
* outer gimbal angle - 59.25 degrees 
The system is started from rest, with all gimbal and 
angular rates zero. The initial condition vector z(0) is: 
X ,(0) = 0 
= (Ope- 
x3(0) = 90 degrees 
xz, (0) = 0 
xq (Oy "= 0 
x¢(0) = 0 
x7(0) = 0 
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xg(0) = 0 
oO) = S72> deguees 
X19 (0)= 0 
X11(0)= 0 


2. Missile Motion 
The missile motion used for the simulation is a 


2 to a 


pitch rate input. The input is applied at 8 rad/sec 
Steady-state value of 1.571 rad/sec, or 90 deg/sec. The 


input reaches steady-state after 0.19 seconds. 


Do TEST RESUS 

The system was initialized using the values above, and 
the pitch input applied. The tabulated data for the simula- 
tion run is included in Appendix D. 

Figure 6.4 shows a plot of U and V gyro error as a func- 
tion of time. The switching points between optimal gain 
regions are shown on the figure. The error graphs show a 
transient error spike when the optimal gains are changed. 
The amplitude of this spike can be made arbitrarily small by 
reducing the size of the optimal control regions. Hpi 
optimal gains were calculated and applied every sample 
interval, the curve would show no such fluctuations. 

A comparision between the errors of the Draper lab Mark 
6 model and the state-space model with optimal control 
region gains is shown in Figures 6.5 and 6.6. The UGSGF 
error signal, Figure 6.5, closely approximates the Draper 
model with the exception of the switching point transients. 
The error damps rapidly after the optimal gain change, main- 
taining a small steady state error. The pitch input to the 
U gyro has a gain including both the SIN(Ay)*SIN(A;) term 
and a SIN(Ac) term, as seen in Figure 4.1. Since both the 
middle and stable gimbal angles are initially zero, the 
pitch rate does not affect the U gyro significantly at the 


start of the simulation run. 
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U and V gyro Errors for the State-Space Model. 


The VGSGF error signal graph, Figure 6.6, shows a less 
pronounced response to missile motion than that experienced 
by the Draper model. The error transients again damp out 
quickly, with the system approaching but not attaining zero 
error at the end of the simulation run. The V gyro shows an 
immediate reSponse to missile motion Since the gain block 
contains a COS(Ac,) term, allowing the pitch rate to affect 
the gyro error aS soon as the middle gimbal angle moves away 
from zero. 

The maximum gyro errors of the Draper lab model and the 


optimal model, neglecting the transient error spikes, are 


e U gyro error Draper lab model 12 quanta 
e U gyro error optimal model 10 quanta 
e V gyro error Draper lab model 94 quanta 
¢ V gyro error optimal model 31 quanta 


The maximum transient errors of the optimal model are 

* U gyro error 83 quanta 

¢ V gyro error 63 quanta 
Figure 6.7 compares the inner versus middle gimbal angle 
of the Draper model and the state-space model. The 
State-Space model exhibits a more rapid middle gimbal angle 
change than the Draper model. The angular rate of the 
middle gimbal angle could be slowed down by varying the 
maximum allowed value of the angle in the Ry weighting 
matrix. A slower angular rate would result in a smaller 
middle gimbal angle, and the SIN(Ay) term in the gain path 
would reduce the effect the missile motion had on the U and 
V gyro errors. A trade-off between the two must be made, 
however, Since the input Signals required to hold the middle 
angle at a Slower rate may adversely affect the gyro errors. 
The inner gimbal angles of both systems translate at 
approximately the same rate. This can be expected Since the 
Sine of the middle angle, not the inner angle, is being 
nulled at the Start of the Simulation. The inner gimbal 


angle is not being controlled. 
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VII. CONCLUSIONS AND RECOMMENDATIONS 


A. CONCLUSIONS 
1. Optimal Design Techniques 

It has been shown that an optimal feedback gain 
controller can successfully control gyro errors and prevent 
gimbal lock. The unique, non-linear nature of the Mark 6 
Gyro requires that several modifications be made to the 
linear quadratic problem solution. 

As the gimbal angles vary, the internal plant gains 
vary. Depending on the gyro orientation, theSe gains can 
range from zero to one. Care must be taken in the regions 
Surrounding zero gain, Since the loop is effectively broken 
at “ENiseepoaner If the optimal control regions chosen are 
too large, the instantaneous switching of the gain from zero 
to a finite value may cause large transient errors from 
which the system is unable to recover. Narrowing the 
optimal control regions near the zero points will lessen the 
impact of the loop suddenly being closed. Increasing the 
number of control regions would also increase the memory 
Size required to store the additional gain values. There 
exists a trade-off between system performance and the amount 
of control hardware required to implement the system. 

The constantly changing gimbal angles also lead to 
numerous set point shifts. It waS Shown in chapter five 
that there exists an optimal control input which drives the 
State to the desired value without exceeding the input 
amplitude limitations. This solution requires that the 
inverse of the closed loop transfer function exists and that 
the number of controlled states is equal to the number of 
inputs. [Ref. 4: p. 279]. If either of these conditions is 
not met, a set point axis shift must be used, which may 


cause large transient errors. Narrowing the optimal control 
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regions in these areas may improve system performance. 


Again, additional memory space would be required. 


B. RECOMMENDATIONS 
l. Improving System Performance 

The gyro controller uSed in the simulation was 
designed using the linear quadratic optimal feedback gain 
design technique. Since the technique provides optimal 
control only at the design point, a region controller will 
not provide optimal response to missile motion throughout 
the region. Changing the weighting matrices R, and Ry for a 
particular region may provide improved system performance 
while still remaining within the allowable torque limits. 
Since the maximum allowable value for the controlled gimbal 
angle and gyro error integrals are essentially arbitrary, 
they can be varied and the resulting system performance 
analyzed to determine if the error in that region can be 
reduced. 

The simulation model also neglected the effects of 
friction, which can reduce net torque to the axes by 3 to 4 
oz-in. The friction effects, which are a function of gimbal 
angular rate, may produce a marked decrease in system 
performance in areas where the angles are changing rapidly. 

Finally, the model assumed that all states were 
available for feedback and that there was no noise input. 
iaeepractical applications, this assumption is invalid. A 
Kalman filter must be designed for the system to provide an 
estimate of the states which can not be measured, and to 
optimize system performance in the presence of both process 
and measurement noise. Harmonics from the gyros and the 
torque motors may have an effect on the system, along with 
Structural noise generated during missile flight. The non- 
linearity and time varying nature of the system make the 


design of a filter particularly complex. 
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APPENDIX A 
DEFINITIONS 


TAB EE 
VARIABLE DEFINITIONS 


Ag stable element gimbal angle 

Ar inner gimbal angle 

Ay middle gimbal angle 

Ao outer gimbal angle 

S stable member inertial rate 

T inner gimbal inertial rate 

M middle gimbal inertial rate 

O outer gimbal inertial rate 

Sg Sine of stable element angle 

Co cosine of stable element angle 

St Sine of inner gimbal angle 

Cr coSine if inner gimbal angle 

Su Sine of middle gimbal angle 

Cm cosine of middle gimbal angle 

So Sine of outer gimbal angle 

Co cosine of outer gimbal angle 

UGSGF U gyro error signal expressed in quanta 
VGSGF V gyro error signal expressed in quanta 
IMU Inertial Measurement Unit 


the gyro and its controller 
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APPENDIX B 
A 


Ll. FOUR GIMBAL IMU MODEL 
This appendix develops the equations which govern the 
gyro motion due to inputs from missile motion and torque 
motors. <A block diagram of the plant is developed from the 
equations, which also leads to the state-space model 
WRet. 2: pp. 2-7]. 
1. Assumptions and Approximations 
This analysis includes the following assumptions and 
approximations: 
¢ Spherical inertias 
¢ Small torques due to gyroScopic effects 
2. Definitions 
Gimbal motion 1S positive in a clockwise direction. 
The transformation from an inner member to an outer member 


is then in the form: 


inner member COS -SIN 0 
C = SIN COS 0 
outer member COS 0 il 


e Standard i,j,k axes will be used. 

°* x, y and z are rate components on the i, j and k axes. 

* p, q and r are body, or missile, motion rates on the i, 
bee k axeS representing pitch, roll and yaw respec- 
tively. 


e A positive torque T applied to a gimbal causes a posi- 
tive, clockwise rotation. 


e Ex, Ey and Ez are the gyro errors sensed on the stable, 
or inertial, member. 
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3. Symboms 


¢ § - Stable member gimbal rate resulting from applied 
Lorque 

¢ I - Inner member gimbal rate resulting from applied 
torque 

* M - Middle member gimbal rate resulting from applied 
torque 

* O - Outer member gimbal rate resulting from applied 
torque 

- As - Stable member seautees rate resulting from relative 
motion between gimbals 

© Ai - Inner member gimbal rate resulting from relative 
motion between gimbals 

¢ Am - Middle member AA rate resulting from relative 
motion between gimbals 

* Ao - Outer member gimbal rate resulting from relative 


motion between gimbals 
4. Transformation of missile motion to inertial member 
a. Base motion © 
Base motion Wb(5) = pi5 + qj5 + rkS 
referred to outer gimbal: (degree of freedom 


along j4 and j5) 


Wb =| 0 1 0 q 
So 0 Co te 
O 
Wbx Co*p - Sor 
Wby : q 
Wbz So7p +) Goi 
0(4) 


Rates along Wby do not couple to outer gimbal. 
O is a rate applied to the outer gimbal from its torque 


motor. 
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Wox Co*p - So*r 

Woy = O 

Woz So*p + Co*r 
0(4) 


b. Outer gimbal to middle gimbal transformation 
Referred to middle gimbal: (degree of freedom 
along the i3 and i4 axes) 


Wox 1 0 0 Co*p - So*r 

Woy = O Cm -Sm 0 

Woz O Sm Cm So*p + Co*r 
M(3) 


Co*p - Sor 
= |Cm*O - Sm(So*p + Co*r) 
Sm*O + Cm(So*p + Co*r) 
Rates along Wox|m do not couple to _ middle 
gimbal. M is the rate of middle gimbal applied by its 
torque motor. 


Wmk M 

Wmy =|Cm*O - Sm*(So*p + Co*p) 

Wmz Sm*O + Cm*(So*p + Co*r) 
M(3) 


c. Middle gimbal to inner gimbal transformation. 
Referred to inner gimbal (degree of freedom 
along k2 and k3 axes): 


47 


Wmx Gi =S1 0 M 
Wmy = | Sale @ ie O Gm~=O - Smee(So~p + Cai 
Wmz 0 O 1 Sm*O + Cm*(So*p + Co*r) 


Ci*m = Si Cm*0 Sm*(So*p + Cosme 
= |Si*m + Ci*ECm*0 Sm*(So*p + Co*r)T 
Sm*O + Cm*(So*p + Co*r) 


Rates along Wmz|I do not couple into inner 


gimbal. I is rate on inner gimbal applied by torque motor, 
therefore: 
Wix Ci*M - Si*ECm*O - Sm*(So*p + Co*r)T 
Wiy = |Si=M + Ci~ECm“O = Sm=(So“p + Corman 
Wiz i 
eZ ) 


d. Inner gimbal to stable member transformation. 
Referred to stable member (degree of freedom 


along 41. and 42eaxes )< 


W1x Gs 05 Ss W1ix 

W1y = 0 1 0 Wiy 

Wiz Ss Q Cs Wiz 
SC 


Cs*Wix - Ss*Wiz 
= W1y 
Ss*Wix + Cs*Wiz 
Rates along Wiy|s do not couple across. BE is 


rate on stable member applied by motor, therefore: 
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Wex Cs*[Ci*M - Si*[Cm*O - Sm*(So*p + Co*r)]] - Ss*I 
Wey]! = E 
Wez Ss*[Ci*M - Si*{Cm*O - Sm*(So*p + Co*r)]] + Cs*I 


e. Four Gimbal Block Diagram. 
The following expressions are used to develop 


the four gimbal IMU block diagram shown in Figure B.1: 


Ap = Wryj1 - Wryjo 
Ay = Wrzko - Wyzk3 
Ay = Wuxi3 - Woxl4 


Ag = Woyj4 - Wpyis 


Ex = Wexly] 
Ey = Wezk1 
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